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Introduction 


•  CAST  Background 
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•  PVF  General  Results 
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CAST  Background 


Capabilities 


•  Improved  Operator  Safety  and  Security: 

-  Eliminates  Rear-End  Collisions 

-  Reduces  Fatigue  &  Eliminates  Road  Departures 

-  Enables  Hands-Free  Response  to  Attack 

-  Reduces  Collateral  Damage  to  Civilian  Population 

•  Improved  Operator  Situational  Awareness: 

-  Increased  IED  Detection  Rate 

-  Ability  to  Detect  Threats  at  Greater  Distance 

•  Automated  Obstacle  Detection  and  Avoidance 

•  Fully  Operational  Across  Typical  Mission  Needs  at 
speeds  consistent  with  human  operators 

•  Autonomous  multi-vehicle  convoys  for  March  Units  up  to 
25  vehicles 

AutoMateTM  kit  still  allows  for  manual  operation  of 
any  tactical  wheeled  vehicle 

Ability  to  maintain  convoy  speeds  consistent  with 
human  operators 

Flexibility  to  Commander  in  field 

Fast,  <10  sec,  convoy  configuration  Ability  to 
change  parameters  on  the  fly 
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History  &  Status 


•  Initiated  by  TARDEC  (2005)  on  Very  Limited  Budget 

•  Conducted  Initial  Feasibility  Demonstrations: 

-  Fort  Carson  (February  2006) 

-  Fort  Gordon  (November  2006) 

•  Conducted  Extensive  Warfighter  Experiments: 

-  Fort  A.P.  Hill  (November  2007) 

-  Nevada  Automotive  Test  Center  (November  2008) 

-  Fort  Hood  (Robotics  Rodeo)  (September  2009) 

-  FortBenning  (September  2010) 

•  Specified  in  Operational  Needs  Statement: 

-  Validated  &  Signed  by  Dep  Chief  of  Staff  (Nov  2009) 

•  CAST  forms  basis  of  AMAS  JCTD 
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-Follow  the  preceding  vehicle  by  fusing  video  and 
radar  data  to  plan  a  safe  path-following  trajectory 


Vehicle  Following 


Road  Following 


Interval  Maintenance 


Obstacle  Detection  &  Avoidance 


-Sense  and  avoid  static  and  dynamic  obstacles  that 
are  near  or  move  to  intercept  a  planned  trajectory 


-Maintain  a  safe  following  distance  behind  the 
preceding  vehicle  and  eliminate  rear-end  collisions 


-Maintain  safe  trajectories  on  both  primary  and 
secondary  roadways  by  sensing  road  geometry 
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Low  Cost  Sensor  Fusion 
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Sensor  price 
point  <  $1,000 

Select  sensors 
that  cover 
maximum  FOV 

Sensor’s  failure 
mechanisms 
overlapped  by 
operation 
envelope  of  other 
sensors 


E^S  Color/fR  Cameras 
1  l  Radar  Long  Range 

a  Radar  Short  Range 

l  l  Ladar 
a  UWB 
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Vehicle  Detection 
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•  Real  Time  Kinematic  Ground  Truth  of 
sensor  measurements  shows  sensor 
performance 

•  No  single  sensor  has  full  or  even 
adequate  detection  of  vehicle 


v 


follower 


Sensor 

Reliable 

Measurements 

Reliable 

% 

Unreliable 

Measurements 

Unreliable 

% 

Error 

Avg 

Error 

Dev 

Error 

Max 

Camera 

2766 

16.10% 

14416 

83.90% 

0.9 

0.33 

2.63 

RADAR 

7018 

97.69% 

166 

2.31% 

0.89 

0.42 

5.65 

GPS 

12880 

74.49% 

4412 

25.51% 

0.23 

0.26 

1.96 

LVD 

8476 

93.38% 

139 

1.61% 

0.96 

0.32 

2.41 
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Vehicle  Tracking 
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•  Use  Multiple  Kalmans,  One  for  Each 
New  Sensor  Measurement 

•  These  Kalman  Filters  Represent 
Multiple  Hypotheses  Of  The  Lead 
Vehicle’s  Position,  Speed,  Heading,  And 
Steering  Radius. 

•  On  Subsequent  Input  Cycles,  Update 
Hypotheses 

•  Select  Track  Based  on  History,  Lead 
Vehicle  State,  Number  of  Recent 
Supporting  Measurements 
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Trajectory  Generation 
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•  The  last  step  is  to  output  a  trajectory  representing  all 
past  estimates  of  leader  position. 

•  If  the  Trajectory  Can  Be  Approximated  as  a  Good 
Estimate  of  Leader  Tran  Relative  Trajectory,  Best  Path  is 
a  Transform  into  Follower’s  Tran  Relative  Frame 

•  Otherwise,  PVF  Generates  a  Trajectory  by  Smoothing 
and  Filtering  the  Path  of  Previous  Leader  Position 
Estimates  i.e.,  “Best”  Kalman  States  Generated  from 
Sensor  Measurements. 


WirttiiiMi  Oapfa. _ 
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PVF  General  Results 


Ignoring  false  positives 
from  camera 
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Ignoring  false  positives 
from  radar 
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•  The  Use  of  Low  Cost  Sensors  Can  Provide  an  Effective 
Solution 

-  Using  Multiple,  Over  Lapping  Sensors  with  Exclusionary  Failure 
Mechanisms 

-  Knowledge  of  Sensor  Performance  and  Associated  Covariance 

-  Specifically  Tuned  to  Solve  Specific  Problem 

•  CAST  Provides  a  Feasible  Solution  to  Relieve  the 
Soldier  of  Driving  in  Order  to  Focus  on  Other  Tasks 
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